ROBUST  MODEL-BASED  FAULT  DIAGNOSIS  FOR 
UNMANNED  UNDERWATER  VEHICLES  USING  SLIDING 

MODE-OBSERVERS 

A.  Alessandri*,  T.  Hawkinson**,  A.  J.  Healey**,  G.  Veruggio* 

*Naval  Automation  Institute,  CNR-IAN  National  Research  Council, 

Via  De  Marini  6,  16149  Genova,  Italy.  Email:  angelo@ian.ge.cnr.it 

**  Center  for  AUV  Research,  Naval  Postgraduate  School, 

700,  Dyer  Road,  Monterey,  CA  93943.  Email:  healey@me.nps.navy.mil 


11th  International  Symposium  on  Unmanned  Untethered  Submersible 
Technology  (UUST’99)  —  August  22  -  25,  1999 


1  Introduction 

The  early  detection  of  the  malfunctions  and  faults  as  well  as  their  compensation  is  crucial  both 
for  maintenance  and  for  mission  reliability  of  unmanned  underwater  vehicles  (UUVs).  Among 
the  different  fault  detection  methods  using  analytical  redundancy,  the  first  distinction  rises 
between  model- free  and  model-based  approaches  [1,  2],  Model- free  methods  are  well-suited  for 
large-scale  systems,  where  the  development  of  a  model  is  too  expensive.  The  lumped  parameter 
model  of  an  underwater  vehicle  can  be  easily  described  by  a  small  set  of  well-known  equations 
with  highly  uncertain  parameters  [3].  This  uncertainty  suggests  the  introduction  of  robustness 
requirements  in  the  model-based  residual  generation  for  UUVs. 

Robustness  can  be  addressed  in  many  different  ways:  for  instance,  the  reader  can  refer  to  [4] 
for  the  parity  equations  and  to  [5]  for  the  observer-based  methods.  According  to  the  same  view, 
the  so-called  unknown  input  observer  (UIO)  has  been  proposed  (see  [6]).  These  approaches 
share  the  common  idea  of  decoupling  residuals  and  noises  by  eliminating  (or  at  least  reducing 
in  some  optimal  sense)  the  influence  of  the  disturbances  on  the  residuals.  Another  way  of  facing 
the  problem  consists  in  applying  the  H ^  filter  design  to  the  residual  generator  [7,  8]. 

All  the  methods  described  up  to  this  point  refer  to  linear  models,  while  the  general  framework 
for  underwater  vehicles  presents  nonlinearities  due  to  the  vehicle  dynamics  and  to  the  features  of 
the  drag  occurring  in  the  water.  The  extension  of  the  residual  generation  methods  to  nonlinear 
systems  has  been  the  subject  of  many  studies  and  an  account  of  all  the  results  can  be  found 
in  [9].  Fault  detection  based  on  parameter  estimation  may  be  applied  to  nonlinear  systems 
when  the  dynamic  equations  are  linear  in  parameters,  but  the  uncertainty  of  common  UUV 
models  introduces  difficulties.  Unknown  input  observers  for  nonlinear  systems  require  a  complex 
state-space  coordinate  transformation,  often  difficult  to  be  computed  (see  the  references  in  [9]). 
Research  about  the  extension  of  parity  equations  to  nonlinear  systems  is  only  just  beginning 
(the  only  paper  known  to  the  authors  is  [10]). 

In  this  paper,  sliding- mode  observers  [11,  12]  are  proposed  for  the  purpose  of  residual  gen¬ 
eration  for  UUV  applications.  In  Section  2  the  problem  of  robust  observation  for  dynamical 
systems  with  “Lipschitz”  nonlinearities  is  addressed  by  means  of  sliding-mode  observers.  A  ro¬ 
bust  observation  scheme  for  the  detection  of  actuator  faults  in  the  Roby  2  UUV  is  presented  in 
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Section  3.  Experimentally  obtained  results  with  a  comparison  between  sliding- mode  observer 
and  EKF  are  shown  in  Section  4. 

2  Robust  observer  design 

Consider  a  quite  general  class  of  nonlinear  systems  with  linear  channel,  which  enables  one  to 
describe  the  dynamics  of  an  underwater  vehicle  in  many  practical  conditions: 

x  =  Ax  +  f  (x)  +  Bu  ^  > 

V_  =  cl  -  “  (1) 

where  x(t)  €  X  C  Rn  is  the  state  vector  and  V_{t)  E  Y  C  is  the  measurement  vector.  The 
channel  is  linear  but  in  general  not  all  the  state  variables  are  measurable.  The  presence  of  the 
nonlinear  function  /  in  (1)  prevents  from  using  the  classical  linear  theory  for  observer  design; 
moreover,  the  parameters  of  the  matrix  A  and  of  the  function  /  are  affected  by  uncertainties. 
This  is  particularly  truthful  for  underwater  vehicles  since  the  marine  environment  introduces 
many  problems  of  modelling  and  the  available  sensors  are  imprecise.  The  uncertainties  in  the 
system  model  suggest  the  utilization  of  sliding  mode  observers,  as  tested  for  many  applications 
[13,  14,  15]. 


sliding-mode  observer 


Figure  1:  scheme  of  the  sliding- mode  nonlinear  observer. 


A  sliding- mode  method  for  the  design  of  observers  for  nonlinear  systems  is  proposed  in  [16], 
where  a  complete  theoretical  investigation  is  provided  in  the  cases  of  stochastic  and  deterministic 
models  and  by  supposing  correlated  noises  acting  on  the  system.  The  structure  of  the  sliding¬ 
mode  observer  is  the  following: 


x  =  Ax  +  f(x)  +  Bu  +  L  (y  —  Cx)  +  S_(x,y) 


(2) 


where 


S(x,y)  =  < 


P-^C1  Ce 

\\Ce\\ 

P~lCTCe 


Ce ||  >  e 

Cell  <  e 


(3) 


where  e  is  the  observation  error,  i.e.,  e(t)  =  x(t)  —  x(t) ,  and  £  is  the  amplitude  of  the  boundary 
layer  [12].  The  symmetric  positive  definite  matrix  P  is  the  solution  of  a  Riccati  equation,  which 
will  be  specified  later  on.  In  [17],  a  link  has  been  investigated  between  the  approach  by  [16]  and 
the  so-called  “Lipschitz”  observer  proposed  in  [18] 
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Theorem  1.  Given  the  system  (1),  if  there  exists  a  gain  matrix  L  such  that  the  Riccati 
equation 

{A-LCf  P  +  P{A-LC)  +  XfPP  +  I  =  -Q  (4) 

has  a  definite  positive  matrix  P  as  solution  (Q  is  a  positive  definite  matrix  and  A y  is  the 
Lipschitz  constant  of  f  ,  i.e.,  \\f(x_i)  —  f(%2)\\  <  A j  \\xx  —  x2\\  ,  V  Xi,x2  G  X  ),  then  the  sliding¬ 
mode  observer  (2)  has  an  asymptotic  error  covergent  to  zero. 

□ 

The  demonstration  of  Theorem  1  is  given  in  [17]  and  it  is  reported  in  the  Appendix.  Theorem 
1  enables  one  to  design  a  sliding- mode  observer  for  nonlinear  systems  as  that  depicted  in  Fig.  1. 
The  robust  observer  design  enables  one  to  generate  residuals  robust  with  respect  to  uncertainties 
in  the  model. 

3  Model-based  fault  detection  by  robust  observers 

Many  methods  can  be  found  in  literature  to  address  model-based  fault  diagnosis  [2],  however 
here  we  refer  to  a  specific  problem  in  underwater  robotics  [19].  Fig.  2  helps  to  explain  the 
problem  of  actuator  faults  for  a  ROV  as  Roby  2  moving  on  a  plane  by  means  of  two  horizontal 
thrusters.  When  one  of  the  two  thruster  fails,  the  dynamic  model  of  the  vehicle  changes,  as 
discussed  in  [19]. 


Figure  2:  picture  of  Roby  2  and  a  sketch  of  the  vehicle  operating  on  a  horizontal  plane. 

To  detect  such  kind  of  faults  a  model-based  approach  seems  more  suitable:  three  models  are 
considered,  one  for  the  system  without  fault,  one  for  the  system  with  left  actuator  fault  and  one 
in  case  of  right  thruster  fault. 

An  observer-based  residual  generator  is  a  filter  able  to  produce  over-sensitive  variables  (i.e., 
the  residuals)  as  innovation  of  the  recursive  equation  of  filter  itself.  Such  a  filter  generates  the 

residual  vector  r (t)  =  y_ (t)  —  C  xft)  according  to  the  model  of  the  fault  used  in  the  design  of  the 
filter  itself.  Thus,  three  models  have  been  considered  for  the  no-fault  case  and  for  the  left  and 
right  actuators  faults,  respectively  (see  Fig.  3).  Both  compass  and  gyro  measurements  have  been 
considered,  while  only  compass  measurements  have  been  used  in  [19].  However,  the  available 
gyro  is  very  noisy  so  that  a  robust  design  of  the  residual  generator  has  been  accomplished. 

Generally  speaking  for  a  model-based  approach,  a  key-point  is  the  choice  of  the  model  used 
to  design  each  observer  of  the  bank.  The  cost  to  estimate  a  complete  model  is  generally  high, 
since  the  UUV  must  be  kept  under  test  in  tank  facilities.  It  is  easier  to  get  simpler  model  of 
the  vehicle  dynamics  by  means  of  sea  or  swimming-pool  tests,  in  order  to  obtain  decoupled 
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reference 


Figure  3:  model-based  bank  of  residual  generators  for  actuator  fault  diagnosis. 


dynamic  equations  of  the  motion  in  the  surge  and  heave  direction  and  of  the  rotation  dynamics 
for  heading  and  diving.  In  the  following,  only  simplified  decoupled  dynamics  of  steering  for 
UUVs  will  be  considered  to  design  robust  residual  generators  for  the  scheme  depicted  in  Fig. 

3  and  a  comparison  will  be  shown  with  a  standard  EKF,  using  the  same  kind  of  input/output 
data. 

4  Experimental  results 

A  dynamic  model  of  a  metacentric  stable  UUV  as  Roby  2  requires  three  equations  in  u  (surge 
speed),  v  (sway  speed),  and  r  (yaw  rate)  to  describe  the  motion  on  the  plane.  Flowever,  the 
only  available  model  is  an  approximate  second  order  dynamic  equation  in  r ,  i.e. , 

Iz  r  +kr  r  +kr ir  r  |r|  =  Mz  (5) 

where  Mz  is  the  torque  input  and  the  parameters  kr  and  kr  r  have  been  experimentally 
identified  [20].  The  models  of  the  vehicle  when  a  right  or  a  left  actuator  fault  occurs  are 
reported  in  [19].  Both  EKF  and  sliding- mode  observers  have  been  considered  to  generate  the 
residuals  rq  ,  r2  ,  and  . 

A  right  actuator  fault  has  been  artificially  caused  in  swimming-pool  and  its  effect  are  de¬ 
scribed  in  Fig.  4. 


Figure  4:  sketch  of  the  manoeuvring  in  case  of  right  actuator  fault. 


Fig.s  5,  6,  and  7  show  the  residuals  rq ,  rq  ,  and  r 3  obtained  with  EKF  and  sliding-mode 
observers  using  the  same  experimental  data.  The  fault  occurs  at  t  =  20s .  As  can  be  noticed, 
the  absolute  value  of  the  residuals  are  lower  in  the  sliding-mode  observers.  Both  the  EKF  and 
the  sliding  mode  do  not  match  exactly  the  gyro  residuals  (see  the  rq  gyro  residuals  before 
t  =  20s )  but  the  sliding-mode  residuals  are  generally  more  stable.  Note  also  that  the  compass 
residuals  do  not  present  changes  at  the  steady  state  after  the  occurrence  of  the  fault  since  the 
closed-loop  regulator  compensates  the  fault,  which  causes  a  variation  of  the  heading.  In  order 
to  reduce  the  effects  of  the  noise,  statistical  testing  are  carried  out  on  the  sliding-window  means 
of  the  residuals,  shown  in  Fig.s  8,  9,  and  10  (the  window  size  is  equal  to  3s ).  The  sliding-mode 
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observer  performs  better  since  its  residuals  reacts  fast  at  the  occurring  of  the  fault  without  the 
overshooting  of  the  EKF. 


EKF  residuals  Sliding-mode  observer  residuals 


Figure  5:  plots  of  the  r i  residuals  for  EKF  and  sliding-mode  observer. 


EKF  residuals  Sliding-mode  observer  residuals 


Figure  6:  plots  of  the  r2  residuals  for  EKF  and  sliding-mode  observer. 


Figure  7:  plots  of  the  r 3  residuals  for  EKF  and  sliding- mode  observer. 
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Figure  8:  means  of  the  r\  residuals  for  EKF  and  sliding-mode  observer. 


Figure  9:  means  of  the  r2  residuals  for  EKF  and  sliding-mode  observer. 


Figure  10:  means  of  the  r%  residuals  for  EKF  and  sliding-mode  observer. 


Appendix 

Let  us  show  the  result  stated  in  Theorem  1.  By  using  equations  (1)  and  (2),  it  is  possible  to 
compute  the  error  dynamics: 

e  =  (A- LC)  e  + l(x)  -  l(x)  -  S(x,y)  (6) 
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Consider  the  Lyapunov  function  V  =  eT  Pe,  where  P  is  a  positive  definite  matrix  and  compute 
it  derivative 

V=eT  [(A-LCf  P  +  P  (A-LC)]e  +  2[l(x)~l(x)}T  Pe-2eT  PS(x,y)  (7) 

By  a  simple  algebra,  we  can  compute  upper  bounds  on  the  last  two  terms  of  (7): 

2  [/(2i)  —  f(x) J  P  (x  —  x)  <  2 \j  \\x  —  x\\  || P  (x  —  x)  || 

<  (x  —  x)T  P P  (x  —  x)  +  {'Ji  —  x)T  (x  —  x)  (8) 

Using  (3),  we  obtain 

V=eT  [{A-LCf  P  +  P  (A  -  LC)  +  \j  P  P  +  i]  e-  2  eT  P  S(x,y)  (9) 

Moreover,  the  variable  structure  term  becomes 


f  2  eTPP~1CTCe  2  eT  CT  C  t 


2eTPS{x,y)  =  { 


\\Ce\\  \\Ce\\ 

2  eTPP~1CTCe  2\\C  e\\2 


=  2\\C e\\  ,  || C e ||  >  e 


\Ce\\  <  e 


(10) 


Thus,  two  cases  should  be  considered,  i.e. ,  || C7 e||  >  e  and  ||Ce||  <  e.  Suppose  || C7 e||  >  e ,  it  is 
easy  to  show  by  (4) 


V  =  -eTQe-2\\Ce\\  <  -Xmin(Q)  ||e||2 -2e  <  0  (11) 

where  A min{Q)  ^ie  minimum  eigenvalue  of  Q.  Now  suppose  HCeH  <  s,  the  derivative  of 

the  Lyapunov  function  becomes 

\\Ce\\2  l  CT  C \ 

V  =  — er  Qe  —  2  ~  < -A mm  Ql - - — 1  ||e||2  <  0  ,  for  ||e||  /  0  (12) 

Thus,  by  means  of  (11)  and  (12),  ||e||  asymptotically  converges  to  zero  if  the  conditions  of 
Theorem  1  are  fulfilled. 
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